//
// Created by sun on 2020/11/15.
//

#ifndef SRC_ROSMATH_H
#define SRC_ROSMATH_H

class RosMath{
public:
    inline static float getDistance(const vector<float> &from,const vector<float> &to){
        return sqrt(
                (from[0]-to[0])*(from[0]-to[0])+
        (from[1]-to[1])*(from[1]-to[1])+
        (from[2]-to[2])*(from[2]-to[2]));
    }
};

#endif //SRC_ROSMATH_H
